#include "modbusRTU.h"
unsigned char RX1_buf[300];
unsigned char public_char_buf[300];
unsigned int AO_Buffer[50];


const unsigned char auchCRCHi[] = {
    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
    0x81,
    0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01,
    0xC0,
    0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
    0x01,
    0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80,
    0x41,
    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1,
    0x81,
    0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01,
    0xC0,
    0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
    0x01,
    0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81,
    0x40,
    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
    0x81,
    0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01,
    0xC0,
    0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
    0x01,
    0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80,
    0x41,
    0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
    0x81,
    0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01,
    0xC0,
    0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
    0x01,
    0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80,
    0x41,
    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
    0x81,
    0x40};
const unsigned char auchCRCLo[] = {
    0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7, 0x05, 0xC5,
    0xC4,
    0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9,
    0x09,
    0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A, 0x1E, 0xDE, 0xDF, 0x1F,
    0xDD,
    0x1D, 0x1C, 0xDC, 0x14, 0xD4, 0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13,
    0xD3,
    0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3, 0xF2, 0x32, 0x36, 0xF6,
    0xF7,
    0x37, 0xF5, 0x35, 0x34, 0xF4, 0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA,
    0x3A,
    0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29, 0xEB, 0x2B, 0x2A, 0xEA,
    0xEE,
    0x2E, 0x2F, 0xEF, 0x2D, 0xED, 0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6,
    0x26,
    0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60, 0x61, 0xA1, 0x63, 0xA3,
    0xA2,
    0x62, 0x66, 0xA6, 0xA7, 0x67, 0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF,
    0x6F,
    0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68, 0x78, 0xB8, 0xB9, 0x79,
    0xBB,
    0x7B, 0x7A, 0xBA, 0xBE, 0x7E, 0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75,
    0xB5,
    0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71, 0x70, 0xB0, 0x50, 0x90,
    0x91,
    0x51, 0x93, 0x53, 0x52, 0x92, 0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C,
    0x5C,
    0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B, 0x99, 0x59, 0x58, 0x98,
    0x88,
    0x48, 0x49, 0x89, 0x4B, 0x8B, 0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C,
    0x8C,
    0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42, 0x43, 0x83, 0x41, 0x81,
    0x80,
    0x40};
unsigned int crc(unsigned char *puchMsg, unsigned int usDataLen)
{
    unsigned char uchCRCHi = 0xFF; /* high byte of CRC initialized */
    unsigned char uchCRCLo = 0xFF; /* low byte of CRC initialized */
    unsigned int uIndex;           /* will index into CRC lookup table */
    unsigned int RET_data;
    while (usDataLen--) /* pass through message buffer */
    {
        uIndex = uchCRCHi ^ *puchMsg++; /* calculate the CRC */
        uchCRCHi = uchCRCLo ^ auchCRCHi[uIndex];
        uchCRCLo = auchCRCLo[uIndex];
    }
    RET_data = (uchCRCHi << 8 | uchCRCLo);
    return RET_data;
}
/*********************************************************
 *??:void Send_ModbusRTU_Err(unsigned char FunNum,ErrNum)
 *??:?? modbus RTU Err ?
 **********************************************************/
void USART1_ModbusRTU_Err(unsigned char FunNum, unsigned char ErrNum, unsigned char ID)
{
    unsigned int crc_result;
    public_char_buf[0] = ID;
    public_char_buf[1] = FunNum + 0x80;
    public_char_buf[2] = ErrNum;
    crc_result = crc(public_char_buf, 3);
    public_char_buf[3] = (unsigned char)(crc_result >> 8);
    public_char_buf[4] = (unsigned char)(crc_result);
    USART1_Send_data(public_char_buf, 5);
}
/*********************************************************
*??:void ModbusRTU__NO3(unsigned char* Msg_buf)
*??:??????????
MODBUS ??:
??? 1 BYTE 0X03
???? 2 BYTE 0X0000 TO 0XFFFF
???? 2 BYTE 1 TO 125(0X7D)
MODBUS ??:
??? 1 BYTE 0X03
???? 1 BYTE N*2
???? N*2 BYTE
[4 ?]????? 03?06?16 ??
**********************************************************/
void ModbusRTU_NO3(unsigned char ID)
{
    unsigned int n;
    unsigned int i, j;
    unsigned int Fun_addr, Fun_num;
    unsigned int crc_result, crc_tmp;
    crc_result = crc(RX1_buf, 6);
    crc_tmp = (RX1_buf[6] << 8) | RX1_buf[7];
    if (crc_tmp != crc_result)
    {
        return;
    }
    Fun_addr = (RX1_buf[2] << 8) | RX1_buf[3];
    Fun_num = (RX1_buf[4] << 8) | RX1_buf[5];
    if ((Fun_num == 0) || (Fun_num > 125))
    {
        USART1_ModbusRTU_Err(3, 3, ID);
        return;
    }
    if (RX1_buf[0] > 100)
    {
        USART1_ModbusRTU_Err(3, 2, ID);
        return;
    }
    public_char_buf[0] = ID;
    public_char_buf[1] = 0x03;
    public_char_buf[2] = Fun_num * 2;
    j = 3;
    // if(Fun_addr==0) n=1;
    // else
    n = Fun_addr + 1;

    for (i = 0; i < Fun_num; i++) //
    {
        public_char_buf[j++] = (unsigned char)(AO_Buffer[n] >> 8);
        public_char_buf[j++] = (unsigned char)AO_Buffer[n];
        n++;
    }
    crc_result = crc(public_char_buf, j);
    public_char_buf[j++] = (unsigned char)(crc_result >> 8);
    public_char_buf[j++] = (unsigned char)(crc_result);
    USART1_Send_data(public_char_buf, j);
}
/*********************************************************
*??:void ModbusRTU_NO6(unsigned char* RX1_buf)
*??:??????????

MODBUS ??
??? 1 BYTE 0X06
???? 2 BYTE 0X0000 TO 0XFFFF
???? 2 BYTE 0x0000 to 0XFF00
MODBUS ??
??? 1 BYTE 0X06
???? 2 BYTE 0X0000 TO 0XFFFF
???? 2 BYTE 0x0000 to 0XFF00
[4 ?]????? 03?06?16 ??
**********************************************************/
void ModbusRTU_NO6(unsigned char ID)
{
    unsigned char i, j;
    unsigned int Fun_addr, Fun_out;
    unsigned int crc_result, crc_tmp;
    crc_result = crc(RX1_buf, 6);
    crc_tmp = (RX1_buf[6] << 8) | RX1_buf[7];
    if (crc_tmp != crc_result)
        return; // CRC ????
    Fun_addr = (RX1_buf[2] << 8) | RX1_buf[3];
    Fun_out = (RX1_buf[4] << 8) | RX1_buf[5];
    if (Fun_out > 0xff00)
    {
        USART1_ModbusRTU_Err(6, 3, ID);
    }
    if (Fun_addr > 100)
    {
        USART1_ModbusRTU_Err(6, 2, ID);
    }
    AO_Buffer[Fun_addr + 1] = Fun_out;
    j = 0;
    for (i = 0; i < 6; i++)
    {
        public_char_buf[i] = RX1_buf[i];
        j++;
    }
    crc_result = crc(public_char_buf, j);
    public_char_buf[j] = (unsigned char)(crc_result >> 8);
    j++;
    public_char_buf[j] = (unsigned char)(crc_result);
    j++;
    USART1_Send_data(public_char_buf, j);
}
/*********************************************************
 *??:void LCD_ModbusRTU_Msg(unsigned char* modmus_buf)
 *??:LCD ????
 **********************************************************/
void ModbusRTU_Msg(unsigned char ID)
{
    if (RX1_buf[0] != ID)
        return;
    switch (RX1_buf[1])
    {
    case 0x03:
    {
        ModbusRTU_NO3(ID);
        break;
    }
    case 0x06:
    {
        ModbusRTU_NO6(ID);
        break;
    }
    }
}
